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ABSTRACT 

The prescribed tasks in high speed robotic systems are severely 
deteriorated because of their manipulator dynamic deflections. On the 
other hand conventional dynamic modeling techniques fail to reveal 
appopriate control forces in flexible systems. In this paper the 
conventional dynamic equations of motion for systems subject to 
kinematical constraints are modified by a new concept of control force 
representation. The directions of the control forces are selected such 
that they correspond to the joint degrees of freedom. Then the joint 
control forces and torques that yield unperturbed prescribed motions are 
solved simultaneously with the system motion. A flexible manipulator is 
presented to illustrate the methods proposed. 


1. INTRODUCTION 


The operation of high speed robots is severely limited by their 
manipulator dynamic deflection. The vibrations deteriorate the accuracies 
of the prescribed tasks assigned to certain points and significantly 
reduce the robot arm production rate. Hence determination of the 
appropriate control forces and torques at the joints that yield stable 
prescribed motions is an important control problem. 

In this paper geometrical constraints represent geometrical 
restrictions such as closed loops and physical guides. On the other hand 
kinematical constraints represent prescribed desired paths or prescribed 
motions of certain points or bodies. Such prescribed motions are to be 
realized by control forces applied by the actuators in the system which 
are usually placed at the joints. 

In the conventional approach, constraints in the system are modeled 
by constraint reaction forces whose directions are perpendicular to the 
constraint surfaces. (See Yoo and Haug [1], Shabana [2], Kamman and Huston 
[3], Hemami and Weimer [4], Nikravesh [5].) Using conventional methods, 
when the prescribed motions are treated as constraint equations and 
embedded into the governing equations of motion, the corresponding 
generalized constraint reaction forces can be determined. However these 
forces cannot be utilized as physically possible control forces due to the 
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presence of components that correspond to the elastic coordinates. For 
this reason previous solution procedures involved feedback and adaptive 
control algorithms which in turn increase the complexity of the problem 
considerably. 

In this paper the kinematical constraints are modeled by general 
direction control forces. The modified equations of motion for flexible 
multibody and robotic systems subject to geometrical and kinematical cons- 
traints are developed. The directions of the control forces are selected 
such that they correspond to the joint degrees of freedom. By this way 
joint control forces and torques that achieve the unperturbed prescribed 
motions are solved simultaneously with the corresponding system motion. 
The modeling of flexible multibody systems in joint space based on finite 
element method and component mode synthesis, as developed in references 
Ider [6], Ider and Amirouche [7] is also outlined. In the equations of 
motion all nonlinear interactions between the rigid body and elastic 
coordinates are automatically incorporated. 

This paper is divided into seven sections. The first section provided 
an introduction. In the second section kinematics and constraint equations 
in flexible multibody systems are outlined. The conventional equations of 
motion for constrained systems are presented in the third section. In 
section four the problems with the conventional approach are discussed. In 
the fifth section the modified equations of motion with general direction 
control forces are developed. Sixth section presents the simulations of a 
flexible manipulator by the proposed method. Conclusions form the last 
section. 


2. FLEXIBLE MULTIBODY KINEMATICS AND CONSTRAINT EQUATIONS 


In a multibody system each joint connection can be described by a total of 
six degrees of freedom. The constrained joint coordinates are eliminated 
In the analysis, hence all possible joint types are allowed. The system 
may contain closed loops and any selected points may have prescribed 
motions. First the recursive dynamical equations are developed for a tree 
configuration which is obtained by cutting the closed loops open (using 
any arbitrary joint in the loop). Closed loops and prescribed motions are 
then imposed as a set of constraint equations. 

In Figure 1, a typical deformable body Bk and its lower connecting 
body Bj are shown. The joint between Bk and Bj is the lower joint of Bk 
and is defined by points Qk and Qk and axis frames n k and n k * fixed at 
these points. The elastic deformations are modeled by finite element 
method with respect to a body reference axis frame denoted by N k . N k , in 
general, is not fixed to a point on the body. It follows the rigid body 
motion of Bk in a manner consistent with the specified boundary 
conditions [6,7]. 

The position of the system can be described by the relative joint 
coordinates of each body and the modal coordinates of the flexible bodies. 
Translation of n k with respect to n k * is denoted by vector z k . For the 
relative rigid body rotation degrees of freedom, successive Euler angles 
in transforming n k to n k * can be used. The modal coordinates nj, j=1,..,m k 
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Figure 1. A multibody system 


of each body Bk represent the normal modes of deformation obtained by 
component mode synthesis and m k is the number of the modes considered. 

Let vector w k represent the angular velocity of n k with respect to 
n k *. Then the genera 1 ized speeds of the system can be conveniently 
selected as the relative angular velocity components, the relative 
translational velocity components and the modal coordinate derivatives. 
The vector of the system generalized speeds y can be defined as 


where 


and 


y = [wt, zT,n T ] T 

w = [w{, w}, wj W?, W 3 V 

z = [z\ , i[, ,..., Z?, Z j , Z^] T 

n= Ml »•••> n7» — n£j T 


(D 

( 2 ) 

( 3 ) 

( 4 ) 


For the dynamical equations we need the velocity, in fixed frame R, 
of an arbitrary point P in finite element i of body Bk. To this end, the 
angular velocity of N k in R, w k , is obtained by summing successive 
relative angular velocites and can be compactly expressed as 


423 



w k = v k w + k r| 


(5) 


where i/ k and K k are the partial angular^velocity matrices composed of the 
coefff icients of the generalized speeds w and q, respectively. 

It can be shown [6,7] that the velocity of point P in R could be 
written as 


v k 1 = a k 1 w + b k z + c k 1 n (6) 

where a k1 , b k and c ki are the partial velocity arrays associated with w, z 
and q, and are functions of displacements only. 

Depending on each joint type, the constrained joint coordinates are 
then eliminated in the generalized speed vectors w and z (equations (2), 
(3)). When the corresponding columns of the partial velocity matrices are 
eliminated, v k and a ki are 3xni matrices, and b k is a 3xnz matrix, where 
ni is the total number of the free joint rotation degrees of freedom and 
n 2 is the total number of the free joint translation degrees of freedom. 
The remaining arrays p k and c ki are 3xm (m=m 1 +. . .+m N ). 

Let the tree structure have n degrees of freedom (n=ni + m + m), and 
let the total number of closed loop and prescribed motion type of 
constraints be c. Then the system’s degrees of freedom reduce to n-c. 

The constraint equations can be generated using the partial velocity 
matrices. For example, if a point say A in Br has a prescribed motion, and 
the prescribed velocity vector of that point is given by g(t) with respect 
to R, then denoting the local undeformed vector from Or to A by s r .the 
resulting three constraint equations are 


a r1 w + b r z + c M q = g 


(7) 


where a M and c ri correspond to s p . 

Similarly if the refence axis frame of Br has a prescribed angular 
velocity h(t), we have 

i/ r w+/* r n =h (8) 

For a closed loop type of constraint, let Br and B« connect with each 
other to form a closed loop in 3-D. Differentiation of the position vector 
equation expressing loop closure leads to the three velocity level 
constraint equations, 


(a M -a a1 ) w + (b r -b 8 ) z + (c r ’-c 8i )n = 0 


(9) 


The holonomlc and nonholonomic constraint equations can be compactly 
written as 
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B y = g 


( 10 ) 


where B is a cxn constraint matrix and g contains prescribed velocities. 


3. CONSTRAINT REACTION FORCES AND EQUATIONS OF NOTION 


Kane’s equations for the constrained system can be written as 

F+F*+S+F c =0 (11) 

where F, F* , S and F c are respectively the vectors of generalized 
external, inertia, stiffness and constraint forces. 

The generalized inertia forces F* can be written in the following 

form, 


F* = M y + Q (12) 

where individual submatrices of M and Q can be expressed in terms of the 
partial velocity matrices [7] as, 


= ZZj 
“ * Vki 


,ki T a ki 


sym. 
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(14) 


The stiffness vector S is obtained from the structural and 
geometrical stiffness matrices of each body expressed in modal 
coordinates. 

The generalized constraint forces F c can be expressed as 


F c = BT X 


(15) 


where X is the vector of undetermined multipliers. Since the rows of B are 
the partial velocity vectors, Xi , 1=1,..., c represent the constraint 
reaction forces generated at the application of the constraints. A row of 
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B can also be viewed as the direction of that constraint in the 
generalized space. 

Substitution of equations (12) and (15) into eq. (11) leads to 

My+S+Q+B T A=F (16) 

Our purpose is to find the accelerations for numerical integration. 
To this end the constraint equations in the acceleration level are 

B y = g - B y 07) 

Equations (16) and (17) constitute n+c equations from which the 
accelerations and the undetermined multipliers can be obtained. 

The multipliers could be eliminated for computational efficiency. To 
this end, let C denote a nx(n-c) matrix which is orthogonal complement to 
B [8], Premultiplying eq. (16) by C T , and combining the resulting equation 
with eq. (17), we obtain the augmented equations for the constrained 
system as below. 


'C T M 


B 

y = 


C T (F-S-Q) ' 
9-By 


( 18 ) 


4. PROBLEMS WITH THE CONVENTIONAL APPROACH 


In the conventional approach the constraints in the system are modeled by 
constraint reaction forces which are perpendicular to constraint surfaces. 
They represent the reactions of the environment. However kinematical cons- 
traints represent desired motions and are meant to be realized by internal 
control forces. Kinematical constraints are particularly important in 
robotic systems where certain points are assigned specific tasks that 
should be realized by joint actuators. 

Let ci of the constraints in the system be geometric and the 
remaining C 2 (c 2 =c-ci) be kinematical. The matrix of the constraint force 
directions B and the vector of constraint force magnitudes A can be 


partitioned such 

that 


B = [B gT 

B* T ] t 

(19) 

and 



A = tX GT 

A kT ] 

(20) 


where the dimensions of B G , B K , A G and A K are cixn, C2xn, ci and C2 
respectively. 

Then eq. (16) can be written in the following form 
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My + Q + S + F G + F IC = F 


( 21 ) 


where the generalized constraint forces F G and F K corresponding 
respectively to geometrical and kinematical constraints are 

f g - b qT X g (22) 


and 


F K = B kT X k (23) 

The constrained system as given by eq. (18) could be simulated to 
determine the generalized constraint forces. In view of eq. (21), then 
control forces numerically equal to F K would yield the same motion of the 
system ensuring the realization of the desired motions. 

However, in flexible systems F K contains components that correspond 
to the elastic coordinates in addition to the components that correspond 
to the joint coordinates. While the latter can be applied by the joint 
actuators as control forces, the former cannot be produced by a physical 
means as control forces. That F K has components in the direction of the 
elastic coordinates is apparent from eqs. (7) and (8) where the 
coefficients of the generalized speeds form the vectors of B K in eq. (23). 
Hence, with the conventional approach it is not possible to design a set 
of control forces that can achieve unperturbed prescribed motions in 
flexible robotic and multibody systems. 


5. CONTROL FORCES FOR KINEMATICAL CONSTRAINTS AND MODIFIED EQUATION OF 
MOTION 

Since kinematical constraints are to be realized by control forces in the 
system, general direction control forces are introduced to the equations 
of motion, so that 

My + Q + S + B Q X QT + B kT X k + A T = F (24) 

where A is a C 2 xn matrix of control force directions and ft Is a C 2 
dimensional vector of control force magnitudes. Let the control force 
directions are selected such that the constraint reaction forces 
corresponding to the kinematical constraints become zero. Then eq. (24) 
can be written as follows, as shown in accompanying paper (Ider [9]). 


My + Q+ S + Z T v=F 


(25) 


where 

Z T = [B qT A t ] 


(26) 
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and 


v T = [X qT |* t ] (27) 

The directions A need to be selected from physical considerations and then 
equations (25) and (17) can be solved together to compute the control 
force magnitudes and the corresponding generalized accelerations. A should 
be chosen such that rank of Z is c, so that C 2 kinematical conditions 
could be controlled. 

Let C be a cx(n-c) matrix orthogonal complement to Z. Premultiplying 
eq. (25) by C T and augmenting with eq. (17), we obtain reduced equations 


C T M' 


£ T (F-S-Q) 

B . 

y = 

. 9-By 


(28) 


The selected control force directions can realize the prescribed 
motions if and only if the augmented mass matrix in eq. (28) Is non 
singular. Hence singularity of the augmented mass matrix represents a 
condition to test the solution. In other words, the directions A should be 
such that the vector space spanned by the rows of B and the vector space 
spanned by the rows of C T are nonintersecting [9]. 

It has been observed that for flexible robotic systems if the control 
forces are selected in the directions along the corresponding joint 
degrees of freedom the augmented mass matrix becomes full rank and hence 
it is possible to realize the kinematical constraints by actuators at the 
joints. This will be illustrated by the simulations of a flexible 
manipulator in the next section. 


6. SIMULATIONS OF A FLEXIBLE MANIPULATOR 


In the planar manipulator shown in Figure 2, link 2 is a flexible link, 
while link 1 is treated rigid. The data used for link 1 are Li=1m, mi=30kg 
and I i = 1 0 kg.m 2 . Link 2 is modeled by beam elements with deformation 
displacement and rotation nodal coordinates [10], and L2=2.7m, a=1.8m, 
m2=15kg, E=68. 95x10® N/m 2 and area A=0.0005 m 2 . The longitudinal 
deformation is neglected due to the axial stiffness and the transverse 
deflection is described by the first two modes since higher modes were 
observed to be negligible. Therefore the generalized coordinates of the 
system are 0i , 02, and modal coordinates m and 02 . The generalized speed 
vector 


y - [ 0 i , 02, ni , n 2 ] T . 

Initially the system is at rest, and 0i=8O° and 02=-16O°. Point A on 
link 2 is required to deploy from the given position 1.5m horizontally. 
The prescribed motion of point A is given as 
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Figure 2. Flexible manipulator 


xa = 1.5 y (t -^sin-^^) + 0-4862 
yA = -0.7878 


(29) 


The constraint equations in the system can be expressed as 


Lici + L2C12 - si 2 ( (pi n 1 + (>2112) = XA 

(30) 

Lisi + L2S12 + ci2((piqi + $202) = yA 

where (pi and $2 are the values that correspond to the location of point A 
in the first and second eigenvectors respectively. ci=cos0i, 
ci 2 =cos( 0 i + 02 ) , si=sin0i and si 2 =sin( 0 i+ 02 ). 

At the acceleration level the constraints are given by eq. (17) where B 
and g are 


B = 


Li S1+L2S1 2+C1 2 ((pin 1 +<»2 n 2 ) 
L1C1+L2C1 2— S12 ( (p 1 n 1 +P2H2 ) 


L2S1 2+C1 2 (Mi+tenz ) 
L2 ci 2 -si 2 (M1+M2 ) 


(PlSl2 (p2 Si 2 

(Pi Cl 2 (P2C12 


and 


g = [XA , 0]T. 


(31) 
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First the system is simulated using the conventional method. Notice 
that both constraints in the system are kinematical. Our objective is to 
determine joint moments Mi and M 2 that would produce unperturbed desired 
motion of point A. The generalized constraint forces in eq. (15) are 


Fi ' 


Xi {Li Si +L 2 St 2 + C 1 2 (tpl n 1 +^> 2 fl 2 ) ] }+ X2{LlCl+L2Cl2-Sl2(<5ini + ®2n2)} 

F| 


Xl {L2Sl2+Cl2(«Pini +020 2 ) } + X 2 {L 2 C 1 2 — Si 2 (01 Hi "^"02 H 2 ) } 

Fa 


Xi $1 Si 2 + X2®1 Cl 2 

Fa. 


.Xl 02 Si 2 + X202C1 2 


The system is simulated for the deployment motion period T=1sec. The 
generalized constraint forces obtained are plotted in Figure 3. ^Notice 
that if one considers Fi and F 2 as joint control moments, f! and Fa will 
be left unaccounted. They cannot be converted to any set of physically 
applicable control forces or moments, and a simulation only with Fi and F 2 
as control moments Mi and M 2 produces perturbations for point A. 



Figure 3. Generalized constraint forces using conventional 
method: 1 . Fi , 2. F 2 , 3. F 3 , Fa 
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Figure 4. Joint moments for unperturbed motion of A. 
Flexible system: 1 . Mi , 2. M 2 
Rigid system: 3. Mi , 4. M 2 


The system is then resimulated by the control force approach 
presented in this paper. The control force directions are selected such 
that they correspond to the joint coordinates 9 i and 62 , i.e. 


' 1 0 0 O' 

A = (33) 

.0 1 0 0 . 


The control forces Vv become 



This means that the required joint moments for unperturbed motion of point 
A are Mi and M 2 =F 2 . 
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With the above control force directions, the augmented mass matrix 
was observed to be full rank, i.e. singularity (or near singularity) did 
not occur, conforming with physical expectations. The joint control 
moments Mi and M 2 that produce unperturbed motion of point A are plotted 
in Figure 4. 

For comparison, the system is resimulated with both bodies considered 
rigid, and the joint moments corresponding to the rigid system are also 
shown in Figure 4. The difference in the control moments for the flexible 
system accounts for the effects of the elastic deformations. 


7. CONCLUSIONS 


This paper presented a general procedure to determine the joint control 
forces and torques in flexible robotic systems, that realize prescribed 
motions in an unperturbed manner. The method is based on a new approach 
for modeling kinematical constraints by general direction control forces. 
The control forces have been selected along the directions of the joint 
degrees of freedom in the generalized space, and the control force 
magnitudes are solved simultaneously with the corresponding system motion. 

It has been shown that with the conventional approach of 
perpendicular constraint forces a solution to the problem cannot be 
obtained. 

In the analysis the flexible bodies have been modeled by finite 
element method and all interactions between the rigid and elastic motion 
have been included. By the procedures presented in this paper the body 
flexibilities can be controlled by applying forces and torques at the 
joints. 


REFERENCES 

1. Yoo, W. S., Haug, E. J., 1986, "Dynamics of Articulated Structures. 
Part I. Theory", Journal gf Structural Mechanics . Vol. 14, pp. 

105-126. 

2. Shabana, A. A., 1985, "Automated Analysis of Constrained Systems of 
Rigid and Flexible Bodies”, ASME Journal gf Vibrations. Acoustics. 
Stress and Reliability In Design, Vol. 107, pp. 431-439. 

3. Kamman, J. W. , Huston. R. L. , 1984, "Dynamics of Constrained Multibody 
Systems" , ASME Journal gf Applied Mechanics. Vol. 51, No. 4, 

pp. 899-903. 

4. Hemaml, H. , Weimer, F. C. , 1981, "Modeling of Nonholonomic Dynamic 
Systems with Applications", ASME Journal gf Applied Mechanics . 

Vol. 48, No. 1, pp. 177-182. 


432 



5. Nikravesh, P. E. , 1984, "Some Methods for Dynamics of Constrained 
Mechanical Systems: A Survey", NATO AS I Series . Vol. F9, Springer- 
Verlag, Berlin, pp. 351-368. 

6. Ider, S. K. , 1988, "Stability and Dynamics of Constrained Flexible 
Multibody Systems", PhD Thesis, University of Illinois at Chicago. 

7. Ider, S. K. , Amirouche, F. M. L., 1989, "Nonlinear Modeling of 
Flexible Multibody Systems Dynamics Subjected to Variable Constraints" 
ASME Journal of Applied Mechanics . Vol. 56, No. 2, pp. 444-450. 

8. Ider, S. K. , Amirouche, F. M. L., 1988, "Coordinate Reduction in the 
Dynamics of Constrained Multibody Systems", ASME Journal of Applied 
Mechanics . Vol. 55, No. 4, pp. 899-905. 

9. Ider, S. K. , 1989, "Modeling of Control Forces for Kinematical Cons- 
traints in the Dynamics of Multibody Systems-A New Approach", 3rd 
Annual Conf . on Aerospace Computational Control . Oxnard, CA, Sept. 

10. Przemieniecki , J. S. , 1968, Theory of Matrix Structural Analysis, 
McGraw-Hill, New York. 

11. Naganathan, G., Soni, A. H., 1986, "Nonlinear Modeling of Kinematic 
and Flexibility Effects in Manipulator Design", ASME Paper, 86-DET-88. 

12. Kane, T. R. , Ryan, R. R. , Banerjee, A. K., 1987, "Dynamics of a 
Cantilever Beam Attached to a Moving Base", Journal of Guidance. 
Control and Dynamics . Vol. 10, No. 2, pp. 139-151. 


433 



